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Abstract 

A new and simple approach to configuration control of redundant manipulators is pre- 
sented paper In this approach, the redundancy is utilized to control the manipulator 

configuration directly in task space, where the task will be performed. A 
matic functions are defined to reflect the desirable configuration that will be achieved 
a given end-effector position. The user-defined kinematic functions and the end-effecto 
Cartesian coordinates are combined to form a set of task-related configuration variables as 
generated coordinates for the manipulator. An adaptive scheme is then utilized to glob- 
ally control the configuration variables so as to achieve tracking of some desired reference 
trajectories This accomplishes the basic task of desired end-effector motion, while utilizing 
+vJ redundancy to achieve any additional task through the desired time variation of the 
kinematic functions. The control law is simple and computationally very fast, and does not 
require the complex manipulator dynamic model. 

1. Introduction 

The remarkable dexterity and versatility that the human arm exhibits in performing 
various tasks can be attributed largely to the kinematic redundancy of the arm, which pro- 
vides the capability of reconfiguring the arm without affecting the hand position. A robotic 
manipulator is called (kinematically) “redundant” if it possesses more degrees-of-freedom 
than is necessary for performing a specified task. For instance, in the three-dimensional 
space, a manipulator with seven or more joints is redundant since six degre ^ “ 
are sufficient to position and orient the end-effector in any desired configuration. Redun- 
dancy of a robotic manipulator is determined relative to the particular task to he V edor ™ e ^ 
For example in the two-dimensional space, a planar robot with three joints is redundant for 
achieving any end-effector position, whereas the robot is non-redundant for tasks invo vmg 
both position and orientation of the end-effector. In a non-redundant manipulator, a given 
position and orientation of the end-effector corresponds to a single set of joint angles and 
an associated unique robot configuration (with distinct poses such as el ow up or own). 
Therefore for a prescribed end-effector motion, the evolution of the robot configuration is 
uniquely determined. When this evolution is undesirable due to collision with obstacles, ap- 
^hlng kinematic singularities or reaching joint limits there is no free om t^econ gure 
the robot so as to reach around the obstacles, or avoid the singularities and joint limits. 

Redundancy in the manipulator structure yields increased dexterity andversatil.tyfbr 
performing a tlk due to the infinite number of joint motions which result in the same 
end-effector trajectory. However, this richness in choice of joint motions complicates the 
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manipulator control problem considerably. In order to take full advantage of the capabilities 
of redundant manipulators, effective control schemes should be deveLped to utiHze the 
redundancy m some useful manner. During recent years, redundant manipulators have been 

^ndincy h°S?wWt reSe m ’ methods haVe bee " SU « gested to rtsolre «« 

rpdnnH o ne ^ suggested the use of Jacobian pseudoinverse to resolve the 

the PaSt *^ “ ’ ^ ° f thG reSearch ° n redund -t manipulators 
f j j P 1 y or implicitly based on the pseudoinverse approach for the utilization 
o redundancy through local optimization of some criterion functional. Furthermore most 
proposed methods resolve the redundancy in joint space and are concerned Z2 with 
mg the inverse kinematic problem for redundant manipulators. 

d,mdL th ri S pape , r ’. a neW and COn J CeptUaI,y simple approach for configuration control of re- 
dundant manipulators is presented, which takes a complete departure from the conventional 

pseudoinverse methods. In this approach, the redundancy is utilised for ylo J controTof 
the manipulator configuration directly in task space, where the task will be performed thus 

cZ^tflrfhed 64 “ maW A of kineL P “;^ 

chosen to reflect the desired additional task that will be performed due to the redundancy 

T l ^ fU f C SUCClnctly characterize the “self-motion” of the manipulator in 

which the internal movement of the links does not move the end-effector. In other words 
the kmematic functions are used to “shape” the manipulator configuration, given the end- 
effector position and orientation. The end-effector Cartesian coordinates ank the kinematk 
functions are combined to form a set of “configuration variables” which describe the phys- 
ca configuration of the entire manipulator in a task-related coordinate system. The^on- 
ol scheme then ensures that the configuration variables track some desired trajectories as 
closely as possible, so that the evolution of the manipulator configuration meets the taS 
requirements The control law is adaptive and does not require knowledge of the complex 
ynamic model or parameter values of the manipulator or payload. The scheme can be im 

‘a teal' 7 deCe . ntralized contro1 structure, and is computationally 
very fast as a real-time algorithm for on-line control of redundant manipulators. 

2. Configuration Control Scheme 

• t y The manipulator under consideration consists of a linkage of rigid bodies 

with « revolute or pnsmatic joints. Let T be the n x 1 vector of torques or forces applied at 

ThVdvnami 1 / $ f X 1 Vect ° r ° f the resuItin « relative joint rotations or translations, 

in the genial form (2] manipulator which relates T to 6 can be represented 

M{6)B + N{0,d)=T 

where the matrices M and N are highly complex nonlinear functions of 6, 0, and the payload 

effl J,? T° T J Mh m < n) FepreSent the position - d orientation of the , end 
effector (last lmk) with respect to a fixed Cartesian coordinate system in the m- dimensional 

task space where the task is to be performed. The m x 1 end-effector coordinate vector Y 
is related to the n x 1 joint angle vector 6 by the forward kinematic model 


Y = Y(6) 


( 2 ) 


7f r p 7^ 18 1 vect or whose elements are nonlinear functions of the joint angles 

and lmk parameters and embodies the geometry of the manipulator. For a redundant 
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manipulator with m < n, a Cartesian coordinate vector (such as Y) that specifies the 
end-effector position and orientation does not constitute a set of generated 
to completely describe the manipulator dynamics. Nonetheless, equations (1) and (2) form 
a valid dynamic model to describe the end-effector motion itself m the task space The 
desired motion of the end-effector is represented by the reference position and orientation 
trajectories denoted by the m x 1 vector Y d (t), where the elements of Yd(t) ^ ^ntmuou 
twice-differentiable functions of time. The vector Y d {t) embodies the information on 
“basic task ” to be accomplished by the end-effector in the task space. 

We shall now discuss the definition of configuration variables and the adaptive control 
of redundant manipulators in the subsequent sections. 

2.1 Definition of Configuration Variables 

Let r = n - m be the “degree-of-redundancy” of the manipulator, i.e. the number of 
“extra” joints. Let us define a set of r kinematic functions <h { e ) » • ; • ’ MO)} t ° re ^ 

the “ additional task ” that will be performed due to the manipulator redundancy Eac & 
can be a function of the joint angles and the link geometric parameters. The 

choice of the kinematic functions can be made in several ways to represent, for instance, the 
coordinates of any point on the manipulator, or any combination of the joint angles. Th 
kinematic functions succinctly characterize the “self-motion” of the manipulator, in which 
the internal movement of the links does not move the end-effector. 

For the sake of illustration, let us consider a planar three-link arm as shown 'n Figure 
im The basic task is to control the end-effector position coordinates [x,y] in the base 
frame Suppose that we fix the end-effector position and allow internal motion of the links 
so that the arm takes all possible configurations. It is found that the locus of point A 
is an arc of a circle with center O and radius £i which satisfies the distance constraint 
AC < (£2 + £3)- Likewise, the locus of point B is an arc of a circle with center C and 
radius £3 which satisfies OB < (£ x + £9). The loci of A and B are shown as hatched arcs 
in Figure l(i), and represent the self-motion of the arm. Now, in order to characterize e 
self-motion, we can select a kinematic function <f>{6) to represent, for instance the terminal 
angle 6 =6, + 6 2 + 0 3 , or alternatively we can designate the wrist height y B as the kinematic 
function <f> = £1 sin 9 v + £ 2 sin(0x + 0 2 ) . The choice of <j> clearly depends on the particular tas 
that we wish to perform by the utilization of redundancy, in addition to the end-effector 
motion. Let us now consider a spatial 7 dof arm [3] as shown in Figure l(n), in which the 
end-effector position and orientation are of concern. The self-motion o th, arm corresp°nds 
to rotation of the elbow point A about the line OB joining the shoulder to the wrist. e 
can now define the kinematic function <f>(9) = a, where a is the angle between a normal 
line from A to OB and a line perpendicular to OB in the vertical plane, as shown in Figure 
l(ii). The kinematic function <j> then succinctly describes the redundancy and gives a simple 
characterization of the self-motion. 

Once a set of r task-related kinematic functions <j> = {<Ai, <£2, • • • . <M “ defined, we have 
partial information on the manipulator configuration. The set of m end-effector position 
and orientation coordinates Y = {yi,y 2> . ..,»«} provides the remaining information on 
the configuration. Let us now combine the two sets <f> and Y to obtain a complete set of n 

configuration variables as 
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( 3 ) 


{^lj 3?2 j . . . , X n } 

The nxl vector X is referred to as the “configuration vector ” of the redundant manipu- 
lator and the elements of X , namely {x u ...,x n }, are called the “configuration variables.” 
The configuration variables {xi, . . . ,x n } constitute a set of generalized coordinates for the 
redundant manipulator. Using the configuration vector X, the manipulator is fully specified 
and is no longer redundant in this representation. It is noted that in some applications, 
certain end-effector coordinates are not relevant to the task, for instance, in a spot welding 
task the orientation of the end-effector is not important. In such cases, the present approach 
allows the designer to replace the insignificant end-effector coordinates with additional kine- 
matic functions which are more relevant to that particular application. In fact, if m'(< m) 

end-effector coordinates are specified, then n - m' = r'(> r) kinematic functions can be 
defined. 

The augmented forward kinematic model which relates the configuration vector X to 
the joint angle vector 0 is now given by 


X = 



( 4 ) 


From equation (4), the differential model which relates the rates of change of X and 0 is 
obtained as 

X(t) = J(O)0(t) (5) 

where 



is the n x n augmented Jacobian matrix. The m x n submatrix J e (0) = ^ is associated 
with the end-effector, while the r x n submatrix J c {0 ) = f£ is related to the kinematic 
functions. The two submatrices J e and J c combine to form the square Jacobian matrix J . 

The augmented Jacobian matrix J can be used to test the functional independence of 
the kinematic functions {<f> 1, . . . , <^ r } and the end-effector coordinates {y^, . . . , y m }. For the 
set of configuration variables X = {x u . . . , x n } to be functionally independent throughout 
the workspace, it suffices to check that det [J(0)] is not identically zero for all 0, [4], In 
other words, when the augmented Jacobian matrix J is rank-deficient for all values of 0, the 
kinematic functions chosen are functionally dependent on the end-effector coordinates and 
a different choice of 4> is necessary. When det [ J(0)] is not identically zero, the configuration 
variables {x u ...,x n } are not functionally dependent for all 0. Nonetheless, there can be 
certain joint configurations 0 = 0 O at which det [J(0 O )] = 0, i.e., the augmented Jacobian 
matrix J . is rank-deficient. This implies that the rows J* of J satisfy the linear relationship 
£,=1 c i JX = 0, where c t are some constants not all zero. Since the changes of the configu- 
ration variables and joint angles are related by Ax = J{0) AO, we conclude that at 0 = 0 O , 
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Y n aAxi = 0. Therefore at a Jacobian singularity, the changes in the configuration vari- 
ables 1 {Axi, Ax n } must satisfy the constraint relationship £"=1 c^Ax, = 0, and hence 
the configuration vector X cannot be changed arbitrarily. 


From expression (6), it is clear that the Jacobian matrix J will be singular at any 
joint configuration for which the submatrix J e is rank-deficient; i.e., at any end-effector 
singular configuration. In addition, the Jacobian J will be singular at those values of 6 for 
which the submatrix J c loses full rank. The latter singularities of J, which are due to the 
kinematic functions, are inevitably introduced whenever an additional task is employed to 
utilize the redundancy. However, by judicious choice of the kinematic functions some of 
the singularities due to J c may be avoided, and the singularities of J may be shifted to the 
unusable part of the workspace. Note that even when J e and J c have full ranks individually, 
the augmented matrix J may still be rank-deficient. 


2.2 Adaptive Configuration Control 

Suppose that a user-defined * additional task” can be expressed by the following kine- 
matic equality constraint relationships 


M0) = MO 

< t > 2(0) = <£<*2(0 


<M#) = &fr(0 

where <f> d i[t) denotes the desired time variation of the kinematic function & and is a user- 
specified continuous twice-differentiable function of time. The kinematic relationships (7) 
r an be represented collectively in the vector form 

<t>(0) = <l>d{t) ( 8 ) 

where ^ is an r x 1 vector. Equation (8) represents a set of “kinematic constraints” 
on the manipulator and defines the task that will be performed in addition to the basic 
task of desired end-effector motion. The kinematic equality constraints (8) are chosen to 
have physical interpretations and are used to formulate the desirable characteristics of the 
manipulator configuration in terms of motion of other members of the manipulator. For 
instance, in the 7 dof arm of Figure l(ii), by controlling the elbow height as well as the 
hand coordinates, we can ensure that the elbow avoids collision with vertical obstacles 
(such as walls) in the workspace while the hand tracks the desired trajectory. Alternatively, 
a particular posture of the manipulator which represents a singular configuration can be 
avoided by an appropriate choice of the kinematic constraints in terms of the joint angles. 
The proposed formulation appears to be a highly promising approach to the additional task 
performance in comparison with the previous approaches which attempt to minimize or 
maximize criterion functionals, since we are now able to make a more specific statemen 
about the evolution of the manipulator configuration. The present approach also covers the 
intuitive solution to redundant arm control in which certain joint angles are held constant 
for a portion of the task in order to resolve the redundancy. The functional forms of the 
kinematic functions fa and their desired behavior <f>di may vary widely for different additional 
tasks, making the approach unrestricted to any particular type of application. 
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Based on the foregoing formulation, we can now consider the manipulator with the 
n x 1 configuration vector X = (J) and the n x n augmented Jacobian matrix J = ( J A. 
Once the desired motion of the end-effector Y d (t) is specified for the particular basic task 
and the required evolution of the kinematic functions <j> d {t) is specified to meet the desired 
additional task, the n x 1 desired configuration vector X d {t) = (Jjgj) is fully determined. 
The configuration control problem for the redundant manipulator is to devise a dynamic 
control scheme as shown in Figure 2 which ensures that the manipulator configuration 
vector X[t) tracks the desired trajectory vector X d (t) as closely as possible. In the control 
system shown in Figure 2, the actual end-effector position Y{t) and the current value of the 
kinematic functions <f>(t) are fed back to the controller. The controller uses this feedback 
information together with the commanded end-effector motion Y d (t) and the desired time 
variation <f> d (t) to compute the driving torques T(t) that are applied at the manipulator 
joints so as to meet the basic and additional task requirements simultaneously. 

Different control strategies can be improvised to meet the above tracking requirement, 
taking into account the dynamics of the manipulator given by equation (1). There are two 
major techniques for the design of tracking controllers in task space, namely model-based 
control and adaptive control. For the model-based control [5], the manipulator dynamics is 
first expressed in task space as 

M x {0)X + N x (0,0) = F (9) 

where F is the n x 1 “virtual” control force vector in the task space, and M x and N x are 
obtained from equations (l)-(6). The control law which achieves tracking through global 
linearization and decoupling is given by 

F = M x (0) [* d (f) + K v (x d (t) - X{t )) + K p (X d (t) - AT(i))] + N x { 0 , 0 ) (io) 

where K p and K v are constant position and velocity feedback gain matrices. This control 
formulation requires precise knowledge of the full dynamic model and parameter values of 
the manipulator and the payload. The alternative approach is the adaptive control technique 
in which the on-line adaptation of the controller gains eliminates the need for the complex 
manipulator dynamic model. In this section, we adopt an adaptive control scheme which 
has been developed recently and validated experimentally on a PUMA industrial robot [6-8]. 
The adaptive controller produces the control signal based on the observed performance of 
the manipulator and has therefore the capability to operate with minimal information on the 
manipulator/payload and to cope with unpredictable gross variations in the payload. The 
proposed adaptive control scheme is developed within the framework of Model Reference 

Adaptive Control (MRAC) theory, and the adaptive tracking control law in the task space 
is given by [6] 

F (*) = d ( '*) + [**(0^(0 + K v {t)E{t) J + \C{t)X d {t) + B{t)X d {t) + A{t)X d {t)\ (11) 

as shown in Figure 3. This control force is composed of three components, namely: 

(i) The auxiliary signal d(t) is synthesized by the adaptation scheme and improves transient 
performance while resulting in better tracking and providing more flexibility in the 
design. 


34 



(ii) The term [K p {t)E{t) + K v {t)E{t)} is due to the PD feedback controller acting on the 
position tracking-error E{t) = X d {t) - X{t) and the velocity tracking-error E{t) = 
X d {t)-X{t). 

(iii) The term [C(t)X d (0 + £(*)*<i(*) + >l(0^d(0] is the contribution of the PD 2 feedforward 
controller operating on the desired position X d (t), the desired velocity X d (t), and the 
desired acceleration 

The required auxiliary signal and feedback/feedforward controller gains are updated based 
on the n x 1 “weighted” error vector q{t) by the following simple adaptation laws [6]: 


q{t) = W p E{t)+W v E{t) 

(12) 

d(t) = d(0) + 61 [ 
Jo 

L 

q(t)dt + 6 2 g(t) 

(13) 

K p (t) = K p { 0) + ai 

[ q(t)E'{t)dt + a 2 q{t)E , (t) 

Jo 

(14) 

K v {t) = K v {0) + p! 

I' q{t)E'{t)dt + (hq(t)E'(t) 

Jo 

(15) 

C(t) = C(0) + 1/1 J 

^ q{t)X d (t)dt i/ 2 q{t)X d [t) 

0 

(16) 

B(t) = B{ 0) + j 

[ q(t)X d (t)dt + i 2 q{t)X d (t) 

0 

(17) 

.A(f) = -A(O) + Ai j 

(‘ 9(()Xi(l)dI + A 29 (t)X i(!) 
0 

(18) 


In equations (13)-(18), {£i,ai,/?i,i'i,7ii Ai} are any positive scalar integral adaptation 
gains, and {£ 2 ,<* 2 , # 2 ,i/ 2 , 7 2 , * 2 } are zero or any positive scalar proportional adaptation 
gains. In equation (12), W p = dia gi {u; pt } and W v = diag^u;^} are constant »x n weighting 
matrices chosen by the designer to reflect the relative significance of the position and velocity 
errors E and E in forming the vector q. The values of the adaptation gains and weighting 
matrices determine the rate at which the tracking-errors converge to zero. 

Since the control actuation is at the manipulator joints, the control force F is imple- 
mented as the joint torque T where 


T(t) = J'(6)F(t) 


(19) 


The augmented Jacobian matrix J(0) is used in equation (19) to map the task forces F(t ) to 
the joint torques T(t). Equation (19) represents the fundamental relationship between the 
task and joint spaces and is the basis for implementation of any task-based control scheme 
[5]. Equation (19) can be rewritten as 


T(t) = 




Fe(t) 

Fc(t) 


= J'(0)F e (t)+J’MFc(t) 


( 20 ) 
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where F e and F, c are the m x 1 and r x 1 control force vectors corresponding to the basic task 
and the additional task, respectively. It is seen that the total control torque is the sum of 
two components: T e = J' e F e , for the end-effector motion (basic task), and T c = J' C F C , for the 
kinematic constraints (additional task). Equation (20) shows distinctly the contributions of 
the basic and the additional tasks to the overall control torque. Under the joint control law 
(20), the desired end-effector trajectory Y d (t) is tracked, and the “extra” degrees-of-freedom 
are conveniently used to control the evolution of the manipulator configuration through 
tracking of the desired kinematic functions <f>d{t). In other words, the self-motion of the 
manipulator is controlled by first characterizing this motion in terms of a set of kinematic 
functions and then controlling these functions through trajectory tracking. 

The adaptive control scheme presented in this section is extremely simple since the 
auxiliary signal and controller gains are evaluated from equations (12)-(18) by simple nu- 
merical integration by using, for instance, the trapezoidal rule. Thus the computational 
time required to calculate the adaptive control law (11) is extremely short. As a result, the 
scheme can be implemented for on-line control of redundant manipulators with high sam- 
pling rates, resulting in improved dynamic performance. This is in contrast to most existing 
approaches which require time-consuming optimization processes unsuitable for fast on-line 
control implementation. It is important to note that the adaptation laws (12)-(18) are based 
solely on the observed performance of the manipulator rather than on any knowledge of the 
complex dynamic model or parameter values of the manipulator and the payload. 


3. Conclusions 

A simple formulation for configuration control of redundant manipulators has been de- 
veloped in this paper. The controller achieves trajectory tracking for the end-effector directly 
in the Cartesian space to perform some desired basic task. In addition, the redundancy is 
utilized by imposing a set of kinematic constraints on the manipulator to accomplish an 
appropriate additional task. The proposed formulation incorporates the kinematic con- 
straints (additional task) and the end-effector motion (basic task) in a conceptually simple 
and computationally efficient manner to resolve the redundancy. Furthermore, the adap- 
tive controller has a very simple structure and the controller gains are adjusted in a simple 
manner to compensate for changing dynamic characteristics of the manipulator. The adap- 
tation laws are based on the observed performance of the manipulator rather than on any 
knowledge of the manipulator dynamic model. Thus, the adaptive controller is capable of 
ensuring a satisfactory performance when the payload mass is unknown and time-varying. 
Any approach used to resolve redundancy should be implementable as a real-time algorithm, 
and therefore the speed of computation is a critical factor. The small amount of compu- 
tations required by the proposed method offers the possibility of fast real-time control of 
redundant manipulators. 
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Figure 1 (i). Self-motion of Planar 3 dof Arm Figure 1 (ii). Self-motion of Spatial 7 dof Arm 
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